home *** CD-ROM | disk | FTP | other *** search
/ CU Amiga Super CD-ROM 12 / CU Amiga Magazine's Super CD-ROM 12 (1997)(EMAP Images)(GB)[!][issue 1997-07].iso / CUCD / Sound / MusicIn / encode.c < prev    next >
C/C++ Source or Header  |  1996-02-16  |  54KB  |  1,564 lines
  1. /**********************************************************************
  2. Copyright (c) 1991 MPEG/audio software simulation group, All Rights Reserved
  3. encode.c
  4. **********************************************************************/
  5. /**********************************************************************
  6.  * MPEG/audio coding/decoding software, work in progress          *
  7.  *   NOT for public distribution until verified and approved by the   *
  8.  *   MPEG/audio committee.  For further information, please contact   *
  9.  *   Davis Pan, 508-493-2241, e-mail: pan@3d.enet.dec.com          *
  10.  *                                      *
  11.  * VERSION 3.9t                               *
  12.  *   changes made since last update:                      *
  13.  *   date   programmers     comment                   *
  14.  * 3/01/91  Douglas Wong,    start of version 1.1 records          *
  15.  *        Davis Pan                              *
  16.  * 3/06/91  Douglas Wong    rename: setup.h to endef.h          *
  17.  *                    efilter to enfilter          *
  18.  *                    ewindow to enwindow          *
  19.  *                integrated "quantizer", "scalefactor",*
  20.  *                and "transmission" files              *
  21.  *                update routine "window_subband"       *
  22.  * 3/31/91  Bill Aspromonte    replaced read_filter by           *
  23.  *                create_an_filter              *
  24.  * 5/10/91  W. Joseph Carter    Ported to Macintosh and Unix.          *
  25.  *                Incorporated Jean-Georges Fritsch's   *
  26.  *                "bitstream.c" package.                *
  27.  *                Incorporated Bill Aspromonte's        *
  28.  *                filterbank coefficient matrix          *
  29.  *                calculation routines and added          *
  30.  *                roundoff to coincide with specs.      *
  31.  *                Modified to strictly adhere to          *
  32.  *                encoded bitstream specs, including    *
  33.  *                "Berlin changes".                     *
  34.  *                Modified PCM sound file handling to   *
  35.  *                process all incoming samples and fill *
  36.  *                out last encoded frame with zeros     *
  37.  *                (silence) if needed.              *
  38.  *                Located and fixed numerous software   *
  39.  *                bugs and table data errors.          *
  40.  * 19jun91  dpwe (Aware)    moved "alloc_*" reader to common.c    *
  41.  *                Globals sblimit, alloc replaced by new*
  42.  *                struct 'frame_params' passed as arg.  *
  43.  *                Added JOINT STEREO coding, layers I,II*
  44.  *                Affects: *_bit_allocation,          *
  45.  *                subband_quantization, encode_bit_alloc*
  46.  *                sample_encoding               *
  47.  * 6/10/91  Earle Jennings    modified II_subband_quantization to   *
  48.  *                resolve type cast problem for MS_DOS  *
  49.  * 6/11/91  Earle Jennings    modified to avoid overflow on MS_DOS  *
  50.  *                in routine filter_subband          *
  51.  * 7/10/91  Earle Jennings    port to MsDos from MacIntosh version  *
  52.  * 8/ 8/91  Jens Spille     Change for MS-C6.00              *
  53.  *10/ 1/91  S.I. Sudharsanan,    Ported to IBM AIX platform.          *
  54.  *        Don H. Lee,                           *
  55.  *        Peter W. Farrett                          *
  56.  *10/ 3/91  Don H. Lee        implemented CRC-16 error protection   *
  57.  *                newly introduced function encode_CRC  *
  58.  *11/ 8/91  Kathy Wang        Documentation of code              *
  59.  *                All variablenames are referred to     *
  60.  *                with surrounding pound (#) signs      *
  61.  * 2/11/92  W. Joseph Carter    Ported new code to Macintosh.  Most   *
  62.  *                important fixes involved changing     *
  63.  *                16-bit ints to long or unsigned in    *
  64.  *                bit alloc routines for quant of 65535 *
  65.  *                and passing proper function args.     *
  66.  *                Removed "Other Joint Stereo" option   *
  67.  *                and made bitrate be total channel     *
  68.  *                bitrate, irrespective of the mode.    *
  69.  *                Fixed many small bugs & reorganized.  *
  70.  * 6/16/92  Shaun Astarabadi    Changed I_scale_factor_calc() and     *
  71.  *                II_scale_factor_calc() to use scale   *
  72.  *                factor 0 thru 62 only and not to      *
  73.  *                encode index 63 into the bit stream.  *
  74.  * 7/27/92  Mike Li        (re-)Port to MS-DOS              *
  75.  * 9/22/92  jddevine@aware.com    Fixed _scale_factor_calc() defs       *
  76.  * 3/31/93  Giogio Dimino    changed II_a_bit_allocation() from:   *
  77.  *                if( ad > ...) to if(ad >= ...)          *
  78.  * 8/05/93  TEST        changed I_a_bit_allocation() from:    *
  79.  *                if( ad > ...) to if(ad >= ...)          *
  80.  * 14/07/95 Stephane TAVENARD   Optimized filter_subband, mod -> fabs *
  81.  * 29/11/95 Stephane TAVENARD   Corrected bug in opt. of filter       *
  82.  **********************************************************************/
  83.  
  84. #define ST_OPTIMIZE
  85.  
  86. #include "common.h"
  87. #include "encoder.h"
  88.  
  89. #ifdef MS_DOS
  90. extern unsigned _stklen = 16384;
  91. #endif
  92.  
  93.  
  94. /*=======================================================================\
  95. |                                    |
  96. | This segment contains all the core routines of the encoder,        |
  97. | except for the psychoacoustic models.                 |
  98. |                                    |
  99. | The user can select either one of the two psychoacoustic        |
  100. | models. Model I is a simple tonal and noise masking threshold     |
  101. | generator, and Model II is a more sophisticated cochlear masking    |
  102. | threshold generator. Model I is recommended for lower complexity    |
  103. | applications whereas Model II gives better subjective quality at low    |
  104. | bit rates.                                |
  105. |                                    |
  106. | Layers I and II of mono, stereo, and joint stereo modes are supported.|
  107. | Routines associated with a given layer are prefixed by "I_" for layer |
  108. | 1 and "II_" for layer 2.                                              |
  109. \=======================================================================*/
  110.  
  111. /************************************************************************/
  112. /*                                    */
  113. /* read_samples()                            */
  114. /*                                    */
  115. /* PURPOSE:  reads the PCM samples from a file to the buffer        */
  116. /*                                    */
  117. /*  SEMANTICS:                                */
  118. /* Reads #samples_read# number of shorts from #musicin# filepointer    */
  119. /* into #sample_buffer[]#.  Returns the number of samples read.     */
  120. /*                                    */
  121. /************************************************************************/
  122.  
  123. /* #define SAVE_SAMPLES_READ */
  124. #define READ_BUFFER_SIZE 65536
  125.  
  126. unsigned long read_samples(musicin, sample_buffer, num_samples, frame_size)
  127. FILE *musicin;
  128. short sample_buffer[2304];
  129. unsigned long num_samples, frame_size;
  130. {
  131.     unsigned long samples_read;
  132.     static unsigned long samples_to_read;
  133.     static char init = TRUE;
  134.     static short *buffer = NULL;
  135.     static short *buffer_ptr;
  136.     static unsigned long buffer_size = 0;
  137. #ifdef SAVE_SAMPLES_READ
  138.     static FILE *sampleout_file = NULL;
  139. #endif
  140.     if (init) {
  141.     samples_to_read = num_samples;
  142.     init = FALSE;
  143.         buffer = (short *)malloc( READ_BUFFER_SIZE * sizeof( short ) );
  144.         if( !buffer ) {
  145.            fprintf( stderr, "Not enough memory to allocate read buffer !\n" );
  146.            exit( 0 );
  147.         }
  148.         buffer_ptr = buffer;
  149. #ifdef SAVE_SAMPLES_READ
  150.         sampleout_file = fopen( "ram:samples_read", "w" );
  151. #endif
  152.      }
  153.     if (samples_to_read >= frame_size)
  154.     samples_read = frame_size;
  155.     else
  156.     samples_read = samples_to_read;
  157.  
  158.     {
  159.        short *b;
  160.        unsigned long remain_size;
  161.        unsigned long size;
  162.        
  163.        b = sample_buffer;
  164.        remain_size = samples_read;
  165.        samples_read = 0;
  166.        
  167.        do {
  168.           if( buffer_size == 0 ) {
  169.               buffer_size = fread( buffer, sizeof( short ), READ_BUFFER_SIZE, musicin );
  170.               buffer_ptr = buffer;
  171.           }
  172.           if( buffer_size > 0 ) {
  173.               size = remain_size;
  174.               if( size > buffer_size ) size = buffer_size;
  175.               memcpy( b, buffer_ptr, size * sizeof( short ) );
  176.               b += size;
  177.               buffer_ptr += size;
  178.               buffer_size -= size;
  179.               remain_size -= size;
  180.               samples_read += size;
  181.           }
  182.           else {
  183.               remain_size = 0;
  184.           }
  185.        } while( remain_size > 0 );
  186.     }
  187. #if 0    
  188.     if ((samples_read =
  189.      fread(sample_buffer, sizeof(short), (int)samples_read, musicin)) == 0)
  190.     printf("Hit end of audio data\n");
  191. #endif        
  192.     samples_to_read -= samples_read;
  193.     if (samples_read < frame_size && samples_read > 0) {
  194.     printf("Insufficient PCM input for one frame - fillout with zeros\n");
  195.     for (; samples_read < frame_size; sample_buffer[samples_read++] = 0);
  196.     samples_to_read = 0;
  197.     }
  198. #ifdef SAVE_SAMPLES_READ
  199.     if( sampleout_file )
  200.        fwrite( sample_buffer, sizeof(short), (int)samples_read, sampleout_file );
  201. #endif     
  202.     return(samples_read);
  203. }
  204.  
  205. /*****************************************************************************/
  206. /*                                         */
  207. /* get_audio()                                     */
  208. /*                                         */
  209. /* PURPOSE:  reads a frame of audio data from a file to the buffer,         */
  210. /*   aligns the data for future processing, and separates the             */
  211. /*   left and right channels                             */
  212. /*                                         */
  213. /*  SEMANTICS:                                     */
  214. /* Calls read_samples() to read a frame of audio data from filepointer         */
  215. /* #musicin# to #insampl[]#.  The data is shifted to make sure the data      */
  216. /* is centered for the 1024pt window to be used by the psychoacoustic model, */
  217. /* and to compensate for the 256 sample delay from the afilter bank. For      */
  218. /* stereo, the channels are also demultiplexed into #buffer[0][]# and         */
  219. /* #buffer[1][]#                                 */
  220. /*                                         */
  221. /*****************************************************************************/
  222.  
  223. unsigned long get_audio(musicin, buffer, num_samples, stereo, lay)
  224. FILE *musicin;
  225. short FAR buffer[2][1152];
  226. unsigned long num_samples;
  227. int stereo, lay;
  228. {
  229.    int j;
  230.    short insamp[2304];
  231.    unsigned long samples_read;
  232.  
  233.    if (lay == 1){
  234.       if(stereo == 2){ /* layer 1, stereo */
  235.      samples_read = read_samples(musicin, insamp, num_samples,
  236.                      (unsigned long) 768);
  237.      for(j=0;j<448;j++) {
  238.         if(j<64) {
  239.            buffer[0][j] = buffer[0][j+384];
  240.            buffer[1][j] = buffer[1][j+384];
  241.         }
  242.         else {
  243.            buffer[0][j] = insamp[2*j-128];
  244.            buffer[1][j] = insamp[2*j-127];
  245.         }
  246.      }
  247.       }
  248.       else { /* layer 1, mono */
  249.      samples_read = read_samples(musicin, insamp, num_samples,
  250.                      (unsigned long) 384);
  251.      for(j=0;j<448;j++){
  252.         if(j<64) {
  253.            buffer[0][j] = buffer[0][j+384];
  254.            buffer[1][j] = 0;
  255.         }
  256.         else {
  257.            buffer[0][j] = insamp[j-64];
  258.            buffer[1][j] = 0;
  259.         }
  260.      }
  261.       }
  262.    }
  263.    else {
  264.       if(stereo == 2){ /* layer 2 (or 3), stereo */
  265.      samples_read = read_samples(musicin, insamp, num_samples,
  266.                      (unsigned long) 2304);
  267.      for(j=0;j<1152;j++) {
  268.         buffer[0][j] = insamp[2*j];
  269.         buffer[1][j] = insamp[2*j+1];
  270.      }
  271.       }
  272.       else { /* layer 2 (or 3), mono */
  273.      samples_read = read_samples(musicin, insamp, num_samples,
  274.                      (unsigned long) 1152);
  275.      for(j=0;j<1152;j++){
  276.         buffer[0][j] = insamp[j];
  277.         buffer[1][j] = 0;
  278.      }
  279.       }
  280.    }
  281.    return(samples_read);
  282. }
  283.  
  284. /************************************************************************/
  285. /*                                    */
  286. /* read_ana_window()                            */
  287. /*                                    */
  288. /* PURPOSE:  Reads encoder window file "enwindow" into array #ana_win#  */
  289. /*                                    */
  290. /************************************************************************/
  291.  
  292. void read_ana_window(ana_win)
  293. double FAR ana_win[HAN_SIZE];
  294. {
  295.     int i,j[4];
  296.     FILE *fp;
  297.     double f[4];
  298.     char t[150];
  299.  
  300.     if (!(fp = OpenTableFile("enwindow") ) ) {
  301.        printf("Please check analysis window table 'enwindow'\n");
  302.        exit(1);
  303.     }
  304.     for (i=0;i<512;i+=4) {
  305.        fgets(t, 150, fp);
  306.        /* ST 10/04/1995 -> spaces suppressed ! -> DICE comp. */
  307.        sscanf(t,"C[%d]=%lf C[%d]=%lf C[%d]=%lf C[%d]=%lf\n",
  308.           j, f,j+1,f+1,j+2,f+2,j+3,f+3);
  309.        if (i==j[0]) {
  310.       ana_win[i] = f[0];
  311.       ana_win[i+1] = f[1];
  312.       ana_win[i+2] = f[2];
  313.       ana_win[i+3] = f[3];
  314. //printf( "%d %f\n%d %f\n%d %f\n%d %f\n",
  315. //      i, f[0], i+1, f[1], i+2, f[2], i+3, f[3] );
  316.        }
  317.        else {
  318.       printf("Check index in analysis window table\n");
  319.       exit(1);
  320.        }
  321.        fgets(t,150,fp);
  322.     }
  323.    fclose(fp);
  324. /*
  325. {
  326.  int i,j;
  327.  double s;
  328.  
  329.  for( i=0; i<64; i++ ) {
  330.    s = 0.0;
  331.    for( j=0; j<8; j++ ) {
  332.       s += ana_win[ i + j*64 ];
  333.    }
  334.    printf( "%d %f\n", i, s );
  335.  }
  336.  exit( 0 );
  337. }
  338. */
  339.  
  340. }
  341.  
  342. /*************************************************************************/
  343. /*                                     */
  344. /* window_subband()                             */
  345. /*                                     */
  346. /* PURPOSE:  Overlapping window on PCM samples                 */
  347. /*                                     */
  348. /* SEMANTICS:                                 */
  349. /* 32 16-bit pcm samples are scaled to fractional 2's complement and     */
  350. /* concatenated to the end of the window buffer #x#. The updated window  */
  351. /* buffer #x# is then windowed by the analysis window #c# to produce the */
  352. /* windowed sample #z#                             */
  353. /*                                     */
  354. /*************************************************************************/
  355.  
  356. void window_subband(buffer, z, k)
  357. short FAR **buffer;
  358. double FAR z[HAN_SIZE];
  359. int k;
  360. {
  361.     typedef double FAR XX[2][HAN_SIZE];
  362.     static XX FAR *x;
  363.     register int i, j; /* ST 15/07/95 : Added register */
  364.     static off[2] = {0,0};
  365.     static char init = 0;
  366.     static double FAR *c;
  367. #ifdef ST_OPTIMIZE /* ST 15/07/95 */
  368.     double *xk, *xm, *zi, *ci;
  369. #endif    
  370.  
  371.     if (!init) {
  372.     c = (double FAR *) mem_alloc(sizeof(double) * HAN_SIZE, "window");
  373.     read_ana_window(c);
  374.     x = (XX FAR *) mem_alloc(sizeof(XX),"x");
  375.     for (i=0;i<2;i++)
  376.         for (j=0;j<HAN_SIZE;j++)
  377.         (*x)[i][j] = 0;
  378.     init = 1;
  379.     }
  380.  
  381. #ifdef ST_OPTIMIZE /* ST 15/07/95 */
  382.     /* replace 32 oldest samples with 32 new samples */
  383.     xk = &(*x)[ k ][ 31 + off[ k ] ];
  384.     for( i=0; i<32; i++ ) {
  385.        *xk-- = ((double) *(*buffer)++) / SCALE;
  386.     }
  387.     /* shift samples into proper window positions */
  388.     zi = z;
  389.     ci = c;
  390. #if 0
  391.     xk = &(*x)[ k ][ off[ k ] ];
  392.     xm = &(*x)[ k ][ HAN_SIZE-1 ];    
  393.     for( i=0; i<HAN_SIZE; i++ ) {
  394.        *zi++ = *xk++ * *ci++;
  395.        if( xk > xm ) {
  396.           xk = &(*x)[ k ][ 0 ];
  397.        }
  398.     }
  399. #else
  400.     xk = &(*x)[ k ][ off[ k ] ];
  401.     xm = &(*x)[ k ][ HAN_SIZE-1 ];
  402.     i = HAN_SIZE - off[ k ];
  403.     while( i-- ) *zi++ = *xk++ * *ci++;
  404.     i = off[ k ];
  405.     if( i > 0 ) {
  406.        xk = &(*x)[ k ][ 0 ];
  407.        while( i-- ) *zi++ = *xk++ * *ci++;
  408.     }
  409. #endif
  410.     off[ k ] += 480;        /*offset is modulo (HAN_SIZE-1)*/
  411.     off[ k ] &= HAN_SIZE-1;
  412. #else
  413.     /* replace 32 oldest samples with 32 new samples */
  414.     for (i=0;i<32;i++) (*x)[k][31-i+off[k]] = (double) *(*buffer)++/SCALE;
  415.     /* shift samples into proper window positions */
  416.     for (i=0;i<HAN_SIZE;i++) z[i] = (*x)[k][(i+off[k])&HAN_SIZE-1] * c[i];
  417.     off[k] += 480;        /*offset is modulo (HAN_SIZE-1)*/
  418.     off[k] &= HAN_SIZE-1;
  419. #endif
  420.  
  421. }
  422.  
  423. /************************************************************************/
  424. /*                                    */
  425. /* create_ana_afilter()                            */
  426. /*                                    */
  427. /* PURPOSE:  Calculates the analysis filter bank coefficients        */
  428. /*                                    */
  429. /* SEMANTICS:                                */
  430. /* Calculates the analysis filterbank coefficients and rounds to the    */
  431. /* 9th decimal place accuracy of the filterbank tables in the ISO    */
  432. /* document.  The coefficients are stored in #filter#            */
  433. /*                                    */
  434. /************************************************************************/
  435.  
  436. void create_ana_filter(filter)
  437. double FAR filter[SBLIMIT][64];
  438. {
  439.    register int i,k;
  440.  
  441.    for (i=0; i<32; i++)
  442.       for (k=0; k<64; k++) {
  443.       if ((filter[i][k] = 1e9*cos((double)((2*i+1)*(16-k)*PI64))) >= 0)
  444.          modf(filter[i][k]+0.5, &filter[i][k]);
  445.       else
  446.          modf(filter[i][k]-0.5, &filter[i][k]);
  447.       filter[i][k] *= 1e-9;
  448. /*      printf( "%d,%d  =  %f\n", i, k, filter[i][k] ); */
  449.    }
  450. }
  451.  
  452. /******************************************************************************/
  453. /*                                          */
  454. /* filter_subband()                                  */
  455. /*                                          */
  456. /* PURPOSE:  Calculates the analysis filter bank coefficients              */
  457. /*                                          */
  458. /* SEMANTICS:                                      */
  459. /*    The windowed samples #z# is filtered by the digital filter matrix #m# */
  460. /* to produce the subband samples #s#. This done by first selectively          */
  461. /* picking out values from the windowed samples, and then multiplying          */
  462. /* them by the filter matrix, producing 32 subband samples.              */
  463. /*                                          */
  464. /******************************************************************************/
  465.  
  466. void filter_subband(z,s)
  467. double FAR z[HAN_SIZE], s[SBLIMIT];
  468. {
  469.    double y[64];
  470.    register int i,j;    /* ST 14/07/95 : Added register */
  471. static char init = 0;
  472.    typedef double MM[SBLIMIT][64];
  473. static MM FAR *m;
  474. #ifdef ST_OPTIMIZE      /* ST 14/07/95 */
  475.    double ysum[ 16 ], ysub[ 16 ];
  476.    double *fe, *ys, *zi;
  477.    double si;
  478. #endif
  479.  
  480. #ifdef MS_DOS
  481.    long    SIZE_OF_MM;
  482.    SIZE_OF_MM       = SBLIMIT*64;
  483.    SIZE_OF_MM       *= 8;
  484.    if (!init) {
  485.        m = (MM FAR *) mem_alloc(SIZE_OF_MM, "filter");
  486.        create_ana_filter(*m);
  487.        init = 1;
  488.    }
  489. #else
  490.    if (!init) {
  491.        m = (MM FAR *) mem_alloc(sizeof(MM), "filter");
  492.        create_ana_filter(*m);
  493.        init = 1;
  494.    }
  495. #endif
  496. #ifdef ST_OPTIMIZE      /* ST 14/07/95 */
  497.  
  498. /*   for( i=0; i<64; i++ ) for (j=0, y[i] = 0;j<8;j++) y[i] += z[i+64*j]; */
  499.    zi = z;
  500.    for( i=0; i<64; i++ ) {
  501.       y[ i ] = *zi + zi[ 64 ] + zi[ 128 ] + zi[ 192 ] +
  502.                zi[ 256 ] + zi[ 320 ] + zi[ 384 ] + zi[ 448 ];
  503.       zi++;
  504.    }
  505.    for( i=0; i<16; i++ ) ysum[ i ] = y[ i ] + y[ 32-i ];
  506.    for( i=0; i<15; i++ ) ysub[ i ] = y[ 33+i ] - y[ 63-i ];
  507.    for( i=0; i<SBLIMIT; i++ ) {
  508.       fe = &((*m)[ i ][ 0 ]);
  509.       si = y[ 16 ];
  510.       ys = ysum;
  511.       for( j=0; j<16; j++ ) si += *fe++ * *ys++;
  512.       fe += 17;
  513.       ys = ysub;
  514.       for( j=0; j<15; j++ ) si += *fe++ * *ys++; /* ST 29/11/95 - 14->15 */
  515.       s[ i ] = si;
  516.    }
  517. #else
  518.    for (i=0;i<64;i++) for (j=0, y[i] = 0;j<8;j++) y[i] += z[i+64*j];
  519.    for (i=0;i<SBLIMIT;i++)
  520.        for (j=0, s[i]= 0;j<64;j++) s[i] += (*m)[i][j] * y[j];
  521. #endif  
  522. }
  523.  
  524. /************************************************************************/
  525. /*                                    */
  526. /* encode_info()                            */
  527. /*                                    */
  528. /* PURPOSE:  Puts the syncword and header information on the output    */
  529. /* bitstream.                                */
  530. /*                                    */
  531. /************************************************************************/
  532.  
  533. void encode_info(fr_ps,bs)
  534. frame_params *fr_ps;
  535. Bit_stream_struc *bs;
  536. {
  537.     layer *info = fr_ps->header;
  538.  
  539.     putbits(bs,0xfff,12);             /* syncword 12 bits */
  540.     put1bit(bs,info->version);         /* ID          1 bit  */
  541.     putbits(bs,4-info->lay,2);         /* layer     2 bits */
  542.     put1bit(bs,!info->error_protection);     /* bit set => no err prot */
  543.     putbits(bs,info->bitrate_index,4);
  544.     putbits(bs,info->sampling_frequency,2);
  545.     put1bit(bs,info->padding);
  546.     put1bit(bs,info->extension);         /* private_bit */
  547.     putbits(bs,info->mode,2);
  548.     putbits(bs,info->mode_ext,2);
  549.     put1bit(bs,info->copyright);
  550.     put1bit(bs,info->original);
  551.     putbits(bs,info->emphasis,2);
  552. }
  553.  
  554. /************************************************************************/
  555. /*                                    */
  556. /* mod()                                */
  557. /*                                    */
  558. /* PURPOSE:  Returns the absolute value of its argument         */
  559. /*                                    */
  560. /************************************************************************/
  561.  
  562. #ifdef ST_OPTIMIZE      /* ST 14/07/95 */
  563. #define mod(a) fabs(a)
  564. #else
  565. double mod(a)
  566. double a;
  567. {
  568.     return (a > 0) ? a : -a;
  569. }
  570. #endif
  571.  
  572. /*************************************************************************/
  573. /*                                     */
  574. /* I_combine_LR    (Layer I)                         */
  575. /* II_combine_LR   (Layer II)                         */
  576. /*                                     */
  577. /* PURPOSE:Combines left and right channels into a mono channel      */
  578. /*                                     */
  579. /* SEMANTICS:  The average of left and right subband samples is put into */
  580. /* #joint_sample#                             */
  581. /*                                     */
  582. /* Layer I and II differ in frame length and # subbands used         */
  583. /*                                     */
  584. /*************************************************************************/
  585.  
  586. void I_combine_LR(sb_sample, joint_sample)
  587. double FAR sb_sample[2][3][SCALE_BLOCK][SBLIMIT];
  588. double FAR joint_sample[3][SCALE_BLOCK][SBLIMIT];
  589. {   /* make a filtered mono for joint stereo */
  590.     int sb, smp;
  591.  
  592.    for(sb = 0; sb<SBLIMIT; ++sb)
  593.       for(smp = 0; smp<SCALE_BLOCK; ++smp)
  594.     joint_sample[0][smp][sb] = .5 *
  595.             (sb_sample[0][0][smp][sb] + sb_sample[1][0][smp][sb]);
  596. }
  597.  
  598. void II_combine_LR(sb_sample, joint_sample, sblimit)
  599. double FAR sb_sample[2][3][SCALE_BLOCK][SBLIMIT];
  600. double FAR joint_sample[3][SCALE_BLOCK][SBLIMIT];
  601. int sblimit;
  602. {  /* make a filtered mono for joint stereo */
  603.    int sb, smp, sufr;
  604.  
  605.    for(sb = 0; sb<sblimit; ++sb)
  606.       for(smp = 0; smp<SCALE_BLOCK; ++smp)
  607.      for(sufr = 0; sufr<3; ++sufr)
  608.         joint_sample[sufr][smp][sb] = .5 * (sb_sample[0][sufr][smp][sb]
  609.                        + sb_sample[1][sufr][smp][sb]);
  610. }
  611.  
  612. /************************************************************************/
  613. /*                                    */
  614. /* I_scale_factor_calc       (Layer I)                    */
  615. /* II_scale_factor_calc    (Layer II)                    */
  616. /*                                    */
  617. /* PURPOSE:For each subband, calculate the scale factor for each set    */
  618. /* of the 12 subband samples                        */
  619. /*                                    */
  620. /* SEMANTICS:  Pick the scalefactor #multiple[]# just larger than the    */
  621. /* absolute value of the peak subband sample of 12 samples,        */
  622. /* and store the corresponding scalefactor index in #scalar#.        */
  623. /*                                    */
  624. /* Layer II has three sets of 12-subband samples for a given        */
  625. /* subband.                                */
  626. /*                                    */
  627. /************************************************************************/
  628.  
  629. void I_scale_factor_calc(sb_sample,scalar,stereo)
  630. double FAR sb_sample[][3][SCALE_BLOCK][SBLIMIT];
  631. unsigned int scalar[][3][SBLIMIT];
  632. int stereo;
  633. {
  634.    int i,j, k;
  635.    double s[SBLIMIT];
  636.  
  637.    for (k=0;k<stereo;k++) {
  638.      for (i=0;i<SBLIMIT;i++)
  639.        for (j=1, s[i] = mod(sb_sample[k][0][0][i]);j<SCALE_BLOCK;j++)
  640.      if (mod(sb_sample[k][0][j][i]) > s[i])
  641.         s[i] = mod(sb_sample[k][0][j][i]);
  642.  
  643.      for (i=0;i<SBLIMIT;i++)
  644.        for (j=SCALE_RANGE-2,scalar[k][0][i]=0;j>=0;j--) /* $A 6/16/92 */
  645.      if (s[i] <= multiple[j]) {
  646.         scalar[k][0][i] = j;
  647.         break;
  648.      }
  649.    }
  650. }
  651.  
  652. /******************************** Layer II ******************************/
  653.  
  654. void II_scale_factor_calc(sb_sample,scalar,stereo,sblimit)
  655. double FAR sb_sample[][3][SCALE_BLOCK][SBLIMIT];
  656. unsigned int scalar[][3][SBLIMIT];
  657. int stereo,sblimit;
  658. {
  659.   int i,j, k,t;
  660.   double s[SBLIMIT];
  661.  
  662.   for (k=0;k<stereo;k++) for (t=0;t<3;t++) {
  663.     for (i=0;i<sblimit;i++)
  664.       for (j=1, s[i] = mod(sb_sample[k][t][0][i]);j<SCALE_BLOCK;j++)
  665.     if (mod(sb_sample[k][t][j][i]) > s[i])
  666.          s[i] = mod(sb_sample[k][t][j][i]);
  667.  
  668.     for (i=0;i<sblimit;i++)
  669.       for (j=SCALE_RANGE-2,scalar[k][t][i]=0;j>=0;j--)      /* $A 6/16/92 */
  670.     if (s[i] <= multiple[j]) {
  671.        scalar[k][t][i] = j;
  672.        break;
  673.     }
  674.       for (i=sblimit;i<SBLIMIT;i++) scalar[k][t][i] = SCALE_RANGE-1;
  675.   }
  676. }
  677.  
  678. /************************************************************************/
  679. /*                                    */
  680. /* pick_scale  (Layer II)                        */
  681. /*                                    */
  682. /* PURPOSE:For each subband, puts the smallest scalefactor of the 3    */
  683. /* associated with a frame into #max_sc#.  This is used         */
  684. /* used by Psychoacoustic Model I.                    */
  685. /* (I would recommend changin max_sc to min_sc)             */
  686. /*                                    */
  687. /************************************************************************/
  688.  
  689. void pick_scale(scalar, fr_ps, max_sc)
  690. unsigned int scalar[2][3][SBLIMIT];
  691. frame_params *fr_ps;
  692. double FAR max_sc[2][SBLIMIT];
  693. {
  694.   int i,j,k,max;
  695.   int stereo  = fr_ps->stereo;
  696.   int sblimit = fr_ps->sblimit;
  697.  
  698.   for (k=0;k<stereo;k++)
  699.     for (i=0;i<sblimit;max_sc[k][i] = multiple[max],i++)
  700.       for (j=1, max = scalar[k][0][i];j<3;j++)
  701.      if (max > scalar[k][j][i]) max = scalar[k][j][i];
  702.   for (i=sblimit;i<SBLIMIT;i++) max_sc[0][i] = max_sc[1][i] = 1E-20;
  703. }
  704.  
  705. /************************************************************************/
  706. /*                                    */
  707. /* put_scale   (Layer I)                        */
  708. /*                                    */
  709. /* PURPOSE:Sets #max_sc# to the scalefactor index in #scalar.        */
  710. /* This is used by Psychoacoustic Model I                */
  711. /*                                    */
  712. /************************************************************************/
  713.  
  714. void put_scale(scalar, fr_ps, max_sc)
  715. unsigned int scalar[2][3][SBLIMIT];
  716. frame_params *fr_ps;
  717. double FAR max_sc[2][SBLIMIT];
  718. {
  719.    int i,j,k, max;
  720.    int stereo  = fr_ps->stereo;
  721.    int sblimit = fr_ps->sblimit;
  722.  
  723.    for (k=0;k<stereo;k++) for (i=0;i<SBLIMIT;i++)
  724.     max_sc[k][i] = multiple[scalar[k][0][i]];
  725. }
  726.  
  727. /**************************************************************************/
  728. /*                                      */
  729. /* II_transmission_pattern (Layer II only)                  */
  730. /*                                      */
  731. /* PURPOSE:For a given subband, determines whether to send 1, 2, or      */
  732. /* all 3 of the scalefactors, and fills in the scalefactor          */
  733. /* select information accordingly                      */
  734. /*                                      */
  735. /* SEMANTICS:  The subbands and channels are classified based on how much */
  736. /* the scalefactors changes over its three values (corresponding      */
  737. /* to the 3 sets of 12 samples per subband).  The classification      */
  738. /* will send 1 or 2 scalefactors instead of three if the scalefactors      */
  739. /* do not change much.    The scalefactor select information,          */
  740. /* #scfsi#, is filled in accordingly.                      */
  741. /*                                      */
  742. /**************************************************************************/
  743.  
  744. void II_transmission_pattern(scalar, scfsi, fr_ps)
  745. unsigned int scalar[2][3][SBLIMIT];
  746. unsigned int scfsi[2][SBLIMIT];
  747. frame_params *fr_ps;
  748. {
  749.    int stereo  = fr_ps->stereo;
  750.    int sblimit = fr_ps->sblimit;
  751.    int dscf[2];
  752.    int class[2],i,j,k;
  753. static int pattern[5][5] = {0x123, 0x122, 0x122, 0x133, 0x123,
  754.                 0x113, 0x111, 0x111, 0x444, 0x113,
  755.                 0x111, 0x111, 0x111, 0x333, 0x113,
  756.                 0x222, 0x222, 0x222, 0x333, 0x123,
  757.                 0x123, 0x122, 0x122, 0x133, 0x123};
  758.  
  759.    for (k=0;k<stereo;k++)
  760.      for (i=0;i<sblimit;i++) {
  761.        dscf[0] =  (scalar[k][0][i]-scalar[k][1][i]);
  762.        dscf[1] =  (scalar[k][1][i]-scalar[k][2][i]);
  763.        for (j=0;j<2;j++) {
  764.      if (dscf[j]<=-3) class[j] = 0;
  765.      else if (dscf[j] > -3 && dscf[j] <0) class[j] = 1;
  766.           else if (dscf[j] == 0) class[j] = 2;
  767.            else if (dscf[j] > 0 && dscf[j] < 3) class[j] = 3;
  768.             else class[j] = 4;
  769.        }
  770.        switch (pattern[class[0]][class[1]]) {
  771.      case 0x123 :     scfsi[k][i] = 0;
  772.              break;
  773.      case 0x122 :     scfsi[k][i] = 3;
  774.              scalar[k][2][i] = scalar[k][1][i];
  775.              break;
  776.      case 0x133 :     scfsi[k][i] = 3;
  777.              scalar[k][1][i] = scalar[k][2][i];
  778.              break;
  779.      case 0x113 :     scfsi[k][i] = 1;
  780.              scalar[k][1][i] = scalar[k][0][i];
  781.              break;
  782.      case 0x111 :     scfsi[k][i] = 2;
  783.              scalar[k][1][i] = scalar[k][2][i] = scalar[k][0][i];
  784.              break;
  785.      case 0x222 :     scfsi[k][i] = 2;
  786.              scalar[k][0][i] = scalar[k][2][i] = scalar[k][1][i];
  787.              break;
  788.      case 0x333 :     scfsi[k][i] = 2;
  789.              scalar[k][0][i] = scalar[k][1][i] = scalar[k][2][i];
  790.              break;
  791.      case 0x444 :     scfsi[k][i] = 2;
  792.              if (scalar[k][0][i] > scalar[k][2][i])
  793.                   scalar[k][0][i] = scalar[k][2][i];
  794.              scalar[k][1][i] = scalar[k][2][i] = scalar[k][0][i];
  795.       }
  796.    }
  797. }
  798.  
  799. /************************************************************************/
  800. /*                                    */
  801. /* I_encode_scale  (Layer I)                        */
  802. /* II_encode_scale (Layer II)                        */
  803. /*                                    */
  804. /* PURPOSE:The encoded scalar factor information is arranged and    */
  805. /* queued into the output fifo to be transmitted.            */
  806. /*                                    */
  807. /* For Layer II, the three scale factors associated with        */
  808. /* a given subband and channel are transmitted in accordance        */
  809. /* with the scfsi, which is transmitted first.                */
  810. /*                                    */
  811. /************************************************************************/
  812.  
  813. void I_encode_scale(scalar, bit_alloc, fr_ps, bs)
  814. unsigned int scalar[2][3][SBLIMIT];
  815. unsigned int bit_alloc[2][SBLIMIT];
  816. frame_params *fr_ps;
  817. Bit_stream_struc *bs;
  818. {
  819.    int stereo  = fr_ps->stereo;
  820.    int sblimit = fr_ps->sblimit;
  821.    int i,j;
  822.  
  823.    for (i=0;i<SBLIMIT;i++) for (j=0;j<stereo;j++)
  824.       if (bit_alloc[j][i]) putbits(bs,scalar[j][0][i],6);
  825. }
  826.  
  827. /***************************** Layer II  ********************************/
  828.  
  829. void II_encode_scale(bit_alloc, scfsi, scalar, fr_ps, bs)
  830. unsigned int bit_alloc[2][SBLIMIT], scfsi[2][SBLIMIT];
  831. unsigned int scalar[2][3][SBLIMIT];
  832. frame_params *fr_ps;
  833. Bit_stream_struc *bs;
  834. {
  835.    int stereo  = fr_ps->stereo;
  836.    int sblimit = fr_ps->sblimit;
  837.    int jsbound = fr_ps->jsbound;
  838.    int i,j,k;
  839.  
  840.    for (i=0;i<sblimit;i++) for (k=0;k<stereo;k++)
  841.      if (bit_alloc[k][i])  putbits(bs,scfsi[k][i],2);
  842.  
  843.    for (i=0;i<sblimit;i++) for (k=0;k<stereo;k++)
  844.      if (bit_alloc[k][i])  /* above jsbound, bit_alloc[0][i] == ba[1][i] */
  845.     switch (scfsi[k][i]) {
  846.        case 0: for (j=0;j<3;j++)
  847.              putbits(bs,scalar[k][j][i],6);
  848.            break;
  849.        case 1:
  850.        case 3: putbits(bs,scalar[k][0][i],6);
  851.            putbits(bs,scalar[k][2][i],6);
  852.            break;
  853.        case 2: putbits(bs,scalar[k][0][i],6);
  854.     }
  855. }
  856.  
  857. /*=======================================================================\
  858. |                                     |
  859. |      The following routines are done after the masking threshold     |
  860. | has been calculated by the fft analysis routines in the Psychoacoustic |
  861. | model. Using the MNR calculated, the actual number of bits allocated     |
  862. | to each subband is found iteratively.                  |
  863. |                                     |
  864. \=======================================================================*/
  865.  
  866. /*************************************************************************/
  867. /*                                     */
  868. /* I_bits_for_nonoise  (Layer I)                     */
  869. /* II_bits_for_nonoise (Layer II)                     */
  870. /*                                     */
  871. /* PURPOSE:Returns the number of bits required to produce a         */
  872. /* mask-to-noise ratio better or equal to the noise/no_noise threshold.  */
  873. /*                                     */
  874. /* SEMANTICS:                                 */
  875. /* bbal = # bits needed for encoding bit allocation             */
  876. /* bsel = # bits needed for encoding scalefactor select information     */
  877. /* banc = # bits needed for ancillary data (header info included)     */
  878. /*                                     */
  879. /* For each subband and channel, will add bits until one of the      */
  880. /* following occurs:                             */
  881. /* - Hit maximum number of bits we can allocate for that subband     */
  882. /* - MNR is better than or equal to the minimum masking level         */
  883. /*   (NOISY_MIN_MNR)                             */
  884. /* Then the bits required for scalefactors, scfsi, bit allocation,     */
  885. /* and the subband samples are tallied (#req_bits#) and returned.     */
  886. /*                                     */
  887. /* (NOISY_MIN_MNR) is the smallest MNR a subband can have before it is     */
  888. /* counted as 'noisy' by the logic which chooses the number of JS        */
  889. /* subbands.                                 */
  890. /*                                     */
  891. /* Joint stereo is supported.                         */
  892. /*                                     */
  893. /*************************************************************************/
  894.  
  895. static double snr[18] = {0.00, 7.00, 11.00, 16.00, 20.84,
  896.              25.28, 31.59, 37.75, 43.84,
  897.              49.89, 55.93, 61.96, 67.98, 74.01,
  898.              80.03, 86.05, 92.01, 98.01};
  899.  
  900. int I_bits_for_nonoise(perm_smr, fr_ps)
  901. double FAR perm_smr[2][SBLIMIT];
  902. frame_params *fr_ps;
  903. {
  904.    int i,j,k;
  905.    int stereo  = fr_ps->stereo;
  906.    int sblimit = fr_ps->sblimit;
  907.    int jsbound = fr_ps->jsbound;
  908.    int req_bits = 0;
  909.  
  910.    /* initial b_anc (header) allocation bits */
  911.    req_bits = 32 + 4 * ( (jsbound * stereo) + (SBLIMIT-jsbound) );
  912.  
  913.    for(i=0; i<SBLIMIT; ++i)
  914.      for(j=0; j<((i<jsbound)?stereo:1); ++j) {
  915.        for(k=0;k<14; ++k)
  916.      if( (-perm_smr[j][i] + snr[k]) >= NOISY_MIN_MNR)
  917.        break; /* we found enough bits */
  918.      if(stereo == 2 && i >= jsbound)     /* check other JS channel */
  919.        for(;k<14; ++k)
  920.          if( (-perm_smr[1-j][i] + snr[k]) >= NOISY_MIN_MNR) break;
  921.      if(k>0) req_bits += (k+1)*SCALE_BLOCK + 6*((i>=jsbound)?stereo:1);
  922.    }
  923.    return req_bits;
  924. }
  925.  
  926. /***************************** Layer II  ********************************/
  927.  
  928. int II_bits_for_nonoise(perm_smr, scfsi, fr_ps)
  929. double FAR perm_smr[2][SBLIMIT];
  930. unsigned int scfsi[2][SBLIMIT];
  931. frame_params *fr_ps;
  932. {
  933.    int sb,ch,ba;
  934.    int stereo  = fr_ps->stereo;
  935.    int sblimit = fr_ps->sblimit;
  936.    int jsbound = fr_ps->jsbound;
  937.    al_table *alloc = fr_ps->alloc;
  938.    int req_bits = 0, bbal = 0, berr = 0, banc = 32;
  939.    int maxAlloc, sel_bits, sc_bits, smp_bits;
  940. static int sfsPerScfsi[] = { 3,2,1,2 };    /* lookup # sfs per scfsi */
  941.  
  942.    /* added 92-08-11 shn */
  943.    if (fr_ps->header->error_protection) berr=16; else berr=0;
  944.  
  945.    for (sb=0; sb<jsbound; ++sb)
  946.      bbal += stereo * (*alloc)[sb][0].bits;
  947.    for (sb=jsbound; sb<sblimit; ++sb)
  948.      bbal += (*alloc)[sb][0].bits;
  949.    req_bits = banc + bbal + berr;
  950.  
  951.    for(sb=0; sb<sblimit; ++sb)
  952.      for(ch=0; ch<((sb<jsbound)?stereo:1); ++ch) {
  953.        maxAlloc = (1<<(*alloc)[sb][0].bits)-1;
  954.        sel_bits = sc_bits = smp_bits = 0;
  955.        for(ba=0;ba<maxAlloc-1; ++ba)
  956.      if( (-perm_smr[ch][sb] + snr[(*alloc)[sb][ba].quant+((ba>0)?1:0)])
  957.          >= NOISY_MIN_MNR)
  958.         break;    /* we found enough bits */
  959.        if(stereo == 2 && sb >= jsbound) /* check other JS channel */
  960.      for(;ba<maxAlloc-1; ++ba)
  961.        if( (-perm_smr[1-ch][sb]+ snr[(*alloc)[sb][ba].quant+((ba>0)?1:0)])
  962.            >= NOISY_MIN_MNR)
  963.          break;
  964.        if(ba>0) {
  965.      smp_bits = SCALE_BLOCK * ((*alloc)[sb][ba].group * (*alloc)[sb][ba].bits);
  966.      /* scale factor bits required for subband */
  967.      sel_bits = 2;
  968.      sc_bits  = 6 * sfsPerScfsi[scfsi[ch][sb]];
  969.      if(stereo == 2 && sb >= jsbound) {
  970.        /* each new js sb has L+R scfsis */
  971.        sel_bits += 2;
  972.        sc_bits  += 6 * sfsPerScfsi[scfsi[1-ch][sb]];
  973.      }
  974.      req_bits += smp_bits+sel_bits+sc_bits;
  975.        }
  976.    }
  977.    return req_bits;
  978. }
  979.  
  980. /*************************************************************************/
  981. /*                                     */
  982. /* I_main_bit_allocation   (Layer I)                     */
  983. /* II_main_bit_allocation  (Layer II)                     */
  984. /*                                     */
  985. /* PURPOSE:For joint stereo mode, determines which of the 4 joint     */
  986. /* stereo modes is needed.  Then calls *_a_bit_allocation(), which     */
  987. /* allocates bits for each of the subbands until there are no more bits  */
  988. /* left, or the MNR is at the noise/no_noise threshold.          */
  989. /*                                     */
  990. /* SEMANTICS:                                 */
  991. /*                                     */
  992. /* For joint stereo mode, joint stereo is changed to stereo if         */
  993. /* there are enough bits to encode stereo at or better than the      */
  994. /* no-noise threshold (NOISY_MIN_MNR).    Otherwise, the system         */
  995. /* iteratively allocates less bits by using joint stereo until one     */
  996. /* of the following occurs:                         */
  997. /* - there are no more noisy subbands (MNR >= NOISY_MIN_MNR)         */
  998. /* - mode_ext has been reduced to 0, which means that all but the     */
  999. /*   lowest 4 subbands have been converted from stereo to joint      */
  1000. /*   stereo, and no more subbands may be converted             */
  1001. /*                                     */
  1002. /*     This function calls *_bits_for_nonoise() and *_a_bit_allocation().*/
  1003. /*                                     */
  1004. /*************************************************************************/
  1005.  
  1006. void I_main_bit_allocation(perm_smr, bit_alloc, adb, fr_ps)
  1007. double FAR perm_smr[2][SBLIMIT];
  1008. unsigned int bit_alloc[2][SBLIMIT];
  1009. int *adb;
  1010. frame_params *fr_ps;
  1011. {
  1012.    int    noisy_sbs;
  1013.    int    mode, mode_ext, lay, i;
  1014.    int    rq_db, av_db = *adb;
  1015. static    int init = 0;
  1016.  
  1017.    if(init == 0) {
  1018.      /* rearrange snr for layer I */
  1019.      snr[2] = snr[3];
  1020.      for (i=3;i<16;i++) snr[i] = snr[i+2];
  1021.      init = 1;
  1022.    }
  1023.  
  1024.    if((mode = fr_ps->actual_mode) == MPG_MD_JOINT_STEREO) {
  1025.      fr_ps->header->mode = MPG_MD_STEREO;
  1026.      fr_ps->header->mode_ext = 0;
  1027.      fr_ps->jsbound = fr_ps->sblimit;
  1028.      if(rq_db = I_bits_for_nonoise(perm_smr, fr_ps) > *adb) {
  1029.        fr_ps->header->mode = MPG_MD_JOINT_STEREO;
  1030.        mode_ext = 4;           /* 3 is least severe reduction */
  1031.        lay = fr_ps->header->lay;
  1032.        do {
  1033.       --mode_ext;
  1034.       fr_ps->jsbound = js_bound(lay, mode_ext);
  1035.       rq_db = I_bits_for_nonoise(perm_smr, fr_ps);
  1036.        } while( (rq_db > *adb) && (mode_ext > 0));
  1037.        fr_ps->header->mode_ext = mode_ext;
  1038.      }      /* well we either eliminated noisy sbs or mode_ext == 0 */
  1039.    }
  1040.    noisy_sbs = I_a_bit_allocation(perm_smr, bit_alloc, adb, fr_ps);
  1041. }
  1042.  
  1043. /***************************** Layer II  ********************************/
  1044.  
  1045. void II_main_bit_allocation(perm_smr, scfsi, bit_alloc, adb, fr_ps)
  1046. double FAR perm_smr[2][SBLIMIT];
  1047. unsigned int scfsi[2][SBLIMIT];
  1048. unsigned int bit_alloc[2][SBLIMIT];
  1049. int *adb;
  1050. frame_params *fr_ps;
  1051. {
  1052.    int    noisy_sbs, nn;
  1053.    int    mode, mode_ext, lay;
  1054.    int    rq_db, av_db = *adb;
  1055.  
  1056.    if((mode = fr_ps->actual_mode) == MPG_MD_JOINT_STEREO) {
  1057.      fr_ps->header->mode = MPG_MD_STEREO;
  1058.      fr_ps->header->mode_ext = 0;
  1059.      fr_ps->jsbound = fr_ps->sblimit;
  1060.      if((rq_db=II_bits_for_nonoise(perm_smr, scfsi, fr_ps)) > *adb) {
  1061.        fr_ps->header->mode = MPG_MD_JOINT_STEREO;
  1062.        mode_ext = 4;           /* 3 is least severe reduction */
  1063.        lay = fr_ps->header->lay;
  1064.        do {
  1065.      --mode_ext;
  1066.      fr_ps->jsbound = js_bound(lay, mode_ext);
  1067.      rq_db = II_bits_for_nonoise(perm_smr, scfsi, fr_ps);
  1068.        } while( (rq_db > *adb) && (mode_ext > 0));
  1069.        fr_ps->header->mode_ext = mode_ext;
  1070.      }      /* well we either eliminated noisy sbs or mode_ext == 0 */
  1071.    }
  1072.    noisy_sbs = II_a_bit_allocation(perm_smr, scfsi, bit_alloc, adb, fr_ps);
  1073. }
  1074.  
  1075. /*************************************************************************/
  1076. /*                                     */
  1077. /* I_a_bit_allocation  (Layer I)                     */
  1078. /* II_a_bit_allocation (Layer II)                     */
  1079. /*                                     */
  1080. /* PURPOSE:Adds bits to the subbands with the lowest mask-to-noise     */
  1081. /* ratios, until the maximum number of bits for the subband has      */
  1082. /* been allocated.                             */
  1083. /*                                     */
  1084. /* SEMANTICS:                                 */
  1085. /* 1. Find the subband and channel with the smallest MNR (#min_sb#,     */
  1086. /*    and #min_ch#)                             */
  1087. /* 2. Calculate the increase in bits needed if we increase the bit     */
  1088. /*    allocation to the next higher level                 */
  1089. /* 3. If there are enough bits available for increasing the resolution     */
  1090. /*    in #min_sb#, #min_ch#, and the subband has not yet reached its     */
  1091. /*    maximum allocation, update the bit allocation, MNR, and bits     */
  1092. /*    available accordingly                         */
  1093. /* 4. Repeat until there are no more bits left, or no more available     */
  1094. /*    subbands. (A subband is still available until the maximum      */
  1095. /*    number of bits for the subband has been allocated, or there     */
  1096. /*    aren't enough bits to go to the next higher resolution in the      */
  1097. /*    subband.)                              */
  1098. /*                                     */
  1099. /*************************************************************************/
  1100.  
  1101. int I_a_bit_allocation(perm_smr, bit_alloc, adb, fr_ps) /* return noisy sbs */
  1102. double FAR perm_smr[2][SBLIMIT];
  1103. unsigned int bit_alloc[2][SBLIMIT];
  1104. int *adb;
  1105. frame_params *fr_ps;
  1106. {
  1107.    int i, k, smpl_bits, scale_bits, min_sb, min_ch, oth_ch;
  1108.    int bspl, bscf, ad, noisy_sbs, done = 0, bbal ;
  1109.    double mnr[2][SBLIMIT], small;
  1110.    char used[2][SBLIMIT];
  1111.    int stereo  = fr_ps->stereo;
  1112.    int sblimit = fr_ps->sblimit;
  1113.    int jsbound = fr_ps->jsbound;
  1114.    al_table *alloc = fr_ps->alloc;
  1115. static char init= 0;
  1116. static int banc=32, berr=0;
  1117.  
  1118.    if (!init) {
  1119.       init = 1;
  1120.       if (fr_ps->header->error_protection) berr = 16;  /* added 92-08-11 shn */
  1121.    }
  1122.    bbal = 4 * ( (jsbound * stereo) + (SBLIMIT-jsbound) );
  1123.    *adb -= bbal + berr + banc;
  1124.    ad= *adb;
  1125.  
  1126.    for (i=0;i<SBLIMIT;i++) for (k=0;k<stereo;k++) {
  1127.      mnr[k][i]=snr[0]-perm_smr[k][i];
  1128.      bit_alloc[k][i] = 0;
  1129.      used[k][i] = 0;
  1130.    }
  1131.    bspl = bscf = 0;
  1132.  
  1133.    do  {
  1134.      /* locate the subband with minimum SMR */
  1135.      small = mnr[0][0]+1;    min_sb = -1; min_ch = -1;
  1136.      for (i=0;i<SBLIMIT;i++) for (k=0;k<stereo;k++)
  1137.        /* go on only if there are bits left */
  1138.        if (used[k][i] != 2 && small > mnr[k][i]) {
  1139.      small = mnr[k][i];
  1140.      min_sb = i;  min_ch = k;
  1141.        }
  1142.      if(min_sb > -1) {     /* there was something to find */
  1143.        /* first step of bit allocation is biggest */
  1144.        if (used[min_ch][min_sb])  { smpl_bits = SCALE_BLOCK; scale_bits = 0; }
  1145.        else              { smpl_bits = 24; scale_bits = 6; }
  1146.        if(min_sb >= jsbound)        scale_bits *= stereo;
  1147.  
  1148.        /* check to see enough bits were available for */
  1149.        /* increasing resolution in the minimum band */
  1150.  
  1151.        if (ad >= bspl + bscf + scale_bits + smpl_bits) {
  1152.      bspl += smpl_bits; /* bit for subband sample */
  1153.      bscf += scale_bits; /* bit for scale factor */
  1154.      bit_alloc[min_ch][min_sb]++;
  1155.      used[min_ch][min_sb] = 1; /* subband has bits */
  1156.      mnr[min_ch][min_sb] = -perm_smr[min_ch][min_sb]
  1157.                    + snr[bit_alloc[min_ch][min_sb]];
  1158.      /* Check if subband has been fully allocated max bits */
  1159.      if (bit_alloc[min_ch][min_sb] ==  14 ) used[min_ch][min_sb] = 2;
  1160.        }
  1161.        else           /* no room to improve this band */
  1162.      used[min_ch][min_sb] = 2; /*    for allocation anymore */
  1163.        if(stereo == 2 && min_sb >= jsbound) {
  1164.      oth_ch = 1-min_ch;  /* joint-st : fix other ch */
  1165.      bit_alloc[oth_ch][min_sb] = bit_alloc[min_ch][min_sb];
  1166.      used[oth_ch][min_sb] = used[min_ch][min_sb];
  1167.      mnr[oth_ch][min_sb] = -perm_smr[oth_ch][min_sb]
  1168.                    + snr[bit_alloc[oth_ch][min_sb]];
  1169.        }
  1170.      }
  1171.    } while(min_sb>-1);       /* i.e. still some sub-bands to find */
  1172.  
  1173.    /* Calculate the number of bits left, add on to pointed var */
  1174.    ad -= bspl+bscf;
  1175.    *adb = ad;
  1176.  
  1177.    /* see how many channels are noisy */
  1178.    noisy_sbs = 0; small = mnr[0][0];
  1179.    for(k=0; k<stereo; ++k) {
  1180.      for(i = 0; i< SBLIMIT; ++i) {
  1181.        if(mnr[k][i] < NOISY_MIN_MNR)   ++noisy_sbs;
  1182.        if(small > mnr[k][i])           small = mnr[k][i];
  1183.      }
  1184.    }
  1185.    return noisy_sbs;
  1186. }
  1187.  
  1188. /***************************** Layer II  ********************************/
  1189.  
  1190. int II_a_bit_allocation(perm_smr, scfsi, bit_alloc, adb, fr_ps)
  1191. double FAR perm_smr[2][SBLIMIT];
  1192. unsigned int scfsi[2][SBLIMIT];
  1193. unsigned int bit_alloc[2][SBLIMIT];
  1194. int *adb;
  1195. frame_params *fr_ps;
  1196. {
  1197.    int i, min_ch, min_sb, oth_ch, k, increment, scale, seli, ba;
  1198.    int bspl, bscf, bsel, ad, noisy_sbs, bbal=0;
  1199.    double mnr[2][SBLIMIT], small;
  1200.    char used[2][SBLIMIT];
  1201.    int stereo  = fr_ps->stereo;
  1202.    int sblimit = fr_ps->sblimit;
  1203.    int jsbound = fr_ps->jsbound;
  1204.    al_table *alloc = fr_ps->alloc;
  1205. static char init= 0;
  1206. static int banc=32, berr=0;
  1207. static int sfsPerScfsi[] = { 3,2,1,2 };    /* lookup # sfs per scfsi */
  1208.  
  1209.    if (!init) {
  1210.        init = 1;
  1211.        if (fr_ps->header->error_protection) berr=16; /* added 92-08-11 shn */
  1212.    }
  1213.    for (i=0; i<jsbound; ++i)
  1214.      bbal += stereo * (*alloc)[i][0].bits;
  1215.    for (i=jsbound; i<sblimit; ++i)
  1216.      bbal += (*alloc)[i][0].bits;
  1217.    *adb -= bbal + berr + banc;
  1218.    ad = *adb;
  1219.  
  1220.    for (i=0;i<sblimit;i++) for (k=0;k<stereo;k++) {
  1221.      mnr[k][i]=snr[0]-perm_smr[k][i];
  1222.      bit_alloc[k][i] = 0;
  1223.      used[k][i] = 0;
  1224.    }
  1225.    bspl = bscf = bsel = 0;
  1226.  
  1227.    do  {
  1228.      /* locate the subband with minimum SMR */
  1229.      small = 999999.0; min_sb = -1; min_ch = -1;
  1230.      for (i=0;i<sblimit;i++) for(k=0;k<stereo;++k)
  1231.        if (used[k][i]  != 2 && small > mnr[k][i]) {
  1232.      small = mnr[k][i];
  1233.      min_sb = i;  min_ch = k;
  1234.      }
  1235.      if(min_sb > -1) {     /* there was something to find */
  1236.        /* find increase in bit allocation in subband [min] */
  1237.        increment = SCALE_BLOCK * ((*alloc)[min_sb][bit_alloc[min_ch][min_sb]+1].group *
  1238.             (*alloc)[min_sb][bit_alloc[min_ch][min_sb]+1].bits);
  1239.        if (used[min_ch][min_sb])
  1240.      increment -= SCALE_BLOCK * ((*alloc)[min_sb][bit_alloc[min_ch][min_sb]].group*
  1241.                (*alloc)[min_sb][bit_alloc[min_ch][min_sb]].bits);
  1242.  
  1243.        /* scale factor bits required for subband [min] */
  1244.        oth_ch = 1 - min_ch;    /* above js bound, need both chans */
  1245.        if (used[min_ch][min_sb]) scale = seli = 0;
  1246.        else {           /* this channel had no bits or scfs before */
  1247.      seli = 2;
  1248.      scale = 6 * sfsPerScfsi[scfsi[min_ch][min_sb]];
  1249.      if(stereo == 2 && min_sb >= jsbound) {
  1250.        /* each new js sb has L+R scfsis */
  1251.        seli += 2;
  1252.        scale += 6 * sfsPerScfsi[scfsi[oth_ch][min_sb]];
  1253.      }
  1254.        }
  1255.        /* check to see enough bits were available for */
  1256.        /* increasing resolution in the minimum band */
  1257.        if (ad >= bspl + bscf + bsel + seli + scale + increment) {
  1258.      ba = ++bit_alloc[min_ch][min_sb]; /* next up alloc */
  1259.      bspl += increment;  /* bits for subband sample */
  1260.      bscf += scale;      /* bits for scale factor */
  1261.      bsel += seli;         /* bits for scfsi code */
  1262.      used[min_ch][min_sb] = 1; /* subband has bits */
  1263.      mnr[min_ch][min_sb] = -perm_smr[min_ch][min_sb] +
  1264.                    snr[(*alloc)[min_sb][ba].quant+1];
  1265.      /* Check if subband has been fully allocated max bits */
  1266.      if (ba >= (1<<(*alloc)[min_sb][0].bits)-1) used[min_ch][min_sb] = 2;
  1267.        }
  1268.        else used[min_ch][min_sb] = 2; /* can't increase this alloc */
  1269.        if(min_sb >= jsbound && stereo == 2) {
  1270.      /* above jsbound, alloc applies L+R */
  1271.      ba = bit_alloc[oth_ch][min_sb] = bit_alloc[min_ch][min_sb];
  1272.      used[oth_ch][min_sb] = used[min_ch][min_sb];
  1273.      mnr[oth_ch][min_sb] = -perm_smr[oth_ch][min_sb] +
  1274.                    snr[(*alloc)[min_sb][ba].quant+1];
  1275.        }
  1276.      }
  1277.    } while(min_sb > -1);   /* until could find no channel */
  1278.    /* Calculate the number of bits left */
  1279.    ad -= bspl+bscf+bsel;   *adb = ad;
  1280.    for (i=sblimit;i<SBLIMIT;i++) for (k=0;k<stereo;k++) bit_alloc[k][i]=0;
  1281.  
  1282.    noisy_sbs = 0;  small = mnr[0][0];       /* calc worst noise in case */
  1283.    for(k=0;k<stereo;++k) {
  1284.      for (i=0;i<sblimit;i++) {
  1285.        if (small > mnr[k][i]) small = mnr[k][i];
  1286.        if(mnr[k][i] < NOISY_MIN_MNR) ++noisy_sbs; /* noise is not masked */
  1287.  
  1288.      }
  1289.    }
  1290.    return noisy_sbs;
  1291. }
  1292.  
  1293. /************************************************************************/
  1294. /*                                    */
  1295. /* I_subband_quantization  (Layer I)                    */
  1296. /* II_subband_quantization (Layer II)                    */
  1297. /*                                    */
  1298. /* PURPOSE:Quantizes subband samples to appropriate number of bits    */
  1299. /*                                    */
  1300. /* SEMANTICS:  Subband samples are divided by their scalefactors, which */
  1301. /* makes the quantization more efficient. The scaled samples are    */
  1302. /* quantized by the function a*x+b, where a and b are functions of    */
  1303. /* the number of quantization levels. The result is then truncated    */
  1304. /* to the appropriate number of bits and the MSB is inverted.        */
  1305. /*                                    */
  1306. /* Note that for fractional 2's complement, inverting the MSB for a     */
  1307. /* negative number x is equivalent to adding 1 to it.            */
  1308. /*                                    */
  1309. /************************************************************************/
  1310.  
  1311. static double a[17] = {
  1312.   0.750000000, 0.625000000, 0.875000000, 0.562500000, 0.937500000,
  1313.   0.968750000, 0.984375000, 0.992187500, 0.996093750, 0.998046875,
  1314.   0.999023438, 0.999511719, 0.999755859, 0.999877930, 0.999938965,
  1315.   0.999969482, 0.999984741 };
  1316.  
  1317. static double b[17] = {
  1318.   -0.250000000, -0.375000000, -0.125000000, -0.437500000, -0.062500000,
  1319.   -0.031250000, -0.015625000, -0.007812500, -0.003906250, -0.001953125,
  1320.   -0.000976563, -0.000488281, -0.000244141, -0.000122070, -0.000061035,
  1321.   -0.000030518, -0.000015259 };
  1322.  
  1323. void I_subband_quantization(scalar, sb_samples, j_scale, j_samps,
  1324.                 bit_alloc, sbband, fr_ps)
  1325. unsigned int scalar[2][3][SBLIMIT];
  1326. double FAR sb_samples[2][3][SCALE_BLOCK][SBLIMIT];
  1327. unsigned int j_scale[3][SBLIMIT];
  1328. double FAR j_samps[3][SCALE_BLOCK][SBLIMIT]; /* L+R for j-stereo if necess */
  1329. unsigned int bit_alloc[2][SBLIMIT];
  1330. unsigned int FAR sbband[2][3][SCALE_BLOCK][SBLIMIT];
  1331. frame_params *fr_ps;
  1332. {
  1333.    int i, j, k, n, sig;
  1334.    int stereo  = fr_ps->stereo;
  1335.    int sblimit = fr_ps->sblimit;
  1336.    int jsbound = fr_ps->jsbound;
  1337.    double d;
  1338. static char init = 0;
  1339.  
  1340.    if (!init) {
  1341.      init = 1;
  1342.      /* rearrange quantization coef to correspond to layer I table */
  1343.      a[1] = a[2]; b[1] = b[2];
  1344.      for (i=2;i<15;i++) { a[i] = a[i+2]; b[i] = b[i+2]; }
  1345.    }
  1346.    for (j=0;j<SCALE_BLOCK;j++) for (i=0;i<SBLIMIT;i++)
  1347.      for (k=0;k<((i<jsbound)?stereo:1);k++)
  1348.        if (bit_alloc[k][i]) {
  1349.      /* for joint stereo mode, have to construct a single subband stream
  1350.         for the js channels.  At present, we calculate a set of mono
  1351.         subband samples and pass them through the scaling system to
  1352.         generate an alternate normalised sample stream.
  1353.  
  1354.         Could normalise both streams (divide by their scfs), then average
  1355.         them.  In bad conditions, this could give rise to spurious
  1356.         cancellations.  Instead, we could just select the sb stream from
  1357.         the larger channel (higher scf), in which case _that_ channel
  1358.         would be 'properly' reconstructed, and the mate would just be a
  1359.         scaled version.  Spec recommends averaging the two (unnormalised)
  1360.         subband channels, then normalising this new signal without
  1361.         actually sending this scale factor... This means looking ahead.
  1362.      */
  1363.      if(stereo == 2 && i>=jsbound)
  1364.        /* use the joint data passed in */
  1365.        d = j_samps[0][j][i] / multiple[j_scale[0][i]];
  1366.      else
  1367.        d = sb_samples[k][0][j][i] / multiple[scalar[k][0][i]];
  1368.      /* scale and quantize floating point sample */
  1369.      n = bit_alloc[k][i];
  1370.      d = d * a[n-1] + b[n-1];
  1371.      /* extract MSB N-1 bits from the floating point sample */
  1372.      if (d >= 0) sig = 1;
  1373.      else { sig = 0; d += 1.0; }
  1374.      sbband[k][0][j][i] = (unsigned int) (d * (double) (1L<<n));
  1375.      /* tag the inverted sign bit to sbband at position N */
  1376.      if (sig) sbband[k][0][j][i] |= 1<<n;
  1377.        }
  1378. }
  1379.  
  1380. /***************************** Layer II  ********************************/
  1381.  
  1382. void II_subband_quantization(scalar, sb_samples, j_scale, j_samps,
  1383.                  bit_alloc, sbband, fr_ps)
  1384. unsigned int scalar[2][3][SBLIMIT];
  1385. double FAR sb_samples[2][3][SCALE_BLOCK][SBLIMIT];
  1386. unsigned int j_scale[3][SBLIMIT];
  1387. double FAR j_samps[3][SCALE_BLOCK][SBLIMIT];
  1388. unsigned int bit_alloc[2][SBLIMIT];
  1389. unsigned int FAR sbband[2][3][SCALE_BLOCK][SBLIMIT];
  1390. frame_params *fr_ps;
  1391. {
  1392.    int i, j, k, s, n, qnt, sig;
  1393.    int stereo  = fr_ps->stereo;
  1394.    int sblimit = fr_ps->sblimit;
  1395.    int jsbound = fr_ps->jsbound;
  1396.    unsigned int stps;
  1397.    double d;
  1398.    al_table *alloc = fr_ps->alloc;
  1399.  
  1400.    for (s=0;s<3;s++)
  1401.      for (j=0;j<SCALE_BLOCK;j++)
  1402.        for (i=0;i<sblimit;i++)
  1403.      for (k=0;k<((i<jsbound)?stereo:1);k++)
  1404.        if (bit_alloc[k][i]) {
  1405.          /* scale and quantize floating point sample */
  1406.          if(stereo == 2 && i>=jsbound)     /* use j-stereo samples */
  1407.            d = j_samps[s][j][i] / multiple[j_scale[s][i]];
  1408.          else
  1409.            d = sb_samples[k][s][j][i] / multiple[scalar[k][s][i]];
  1410.          if (mod(d) > 1.0)
  1411.            printf("Not scaled properly %d %d %d %d\n",k,s,j,i);
  1412.          qnt = (*alloc)[i][bit_alloc[k][i]].quant;
  1413.          d = d * a[qnt] + b[qnt];
  1414.          /* extract MSB N-1 bits from the floating point sample */
  1415.          if (d >= 0) sig = 1;
  1416.          else { sig = 0; d += 1.0; }
  1417.          n = 0;
  1418. #ifndef MS_DOS
  1419.          stps = (*alloc)[i][bit_alloc[k][i]].steps;
  1420.          while ((1L<<n) < stps) n++;
  1421. #else
  1422.          while  ( ( (unsigned long)(1L<<(long)n) <
  1423.                ((unsigned long) ((*alloc)[i][bit_alloc[k][i]].steps)
  1424.             & 0xffff
  1425.             )
  1426.                ) && ( n <16)
  1427.              ) n++;
  1428. #endif
  1429.          n--;
  1430.          sbband[k][s][j][i] = (unsigned int) (d * (double) (1L<<n));
  1431.          /* tag the inverted sign bit to sbband at position N */
  1432.          /* The bit inversion is a must for grouping with 3,5,9 steps
  1433.         so it is done for all subbands */
  1434.          if (sig) sbband[k][s][j][i] |= 1<<n;
  1435.        }
  1436.        for (s=0;s<3;s++)
  1437.          for (j=sblimit;j<SBLIMIT;j++)
  1438.            for (i=0;i<SCALE_BLOCK;i++) for (k=0;k<stereo;k++) sbband[k][s][i][j] = 0;
  1439. }
  1440.  
  1441. /************************************************************************/
  1442. /*                                    */
  1443. /* I_encode_bit_alloc  (Layer I)                    */
  1444. /* II_encode_bit_alloc (Layer II)                    */
  1445. /*                                    */
  1446. /* PURPOSE:Writes bit allocation information onto bitstream        */
  1447. /*                                    */
  1448. /* Layer I uses 4 bits/subband for bit allocation information,        */
  1449. /* and Layer II uses 4,3,2, or 0 bits depending on the            */
  1450. /* quantization table used.                        */
  1451. /*                                    */
  1452. /************************************************************************/
  1453.  
  1454. void I_encode_bit_alloc(bit_alloc, fr_ps, bs)
  1455. unsigned int bit_alloc[2][SBLIMIT];
  1456. frame_params *fr_ps;
  1457. Bit_stream_struc *bs;
  1458. {
  1459.    int i,k;
  1460.    int stereo  = fr_ps->stereo;
  1461.    int sblimit = fr_ps->sblimit;
  1462.    int jsbound = fr_ps->jsbound;
  1463.  
  1464.    for (i=0;i<SBLIMIT;i++)
  1465.      for (k=0;k<((i<jsbound)?stereo:1);k++) putbits(bs,bit_alloc[k][i],4);
  1466. }
  1467.  
  1468. /***************************** Layer II  ********************************/
  1469.  
  1470. void II_encode_bit_alloc(bit_alloc, fr_ps, bs)
  1471. unsigned int bit_alloc[2][SBLIMIT];
  1472. frame_params *fr_ps;
  1473. Bit_stream_struc *bs;
  1474. {
  1475.    int i,k;
  1476.    int stereo  = fr_ps->stereo;
  1477.    int sblimit = fr_ps->sblimit;
  1478.    int jsbound = fr_ps->jsbound;
  1479.    al_table *alloc = fr_ps->alloc;
  1480.  
  1481.    for (i=0;i<sblimit;i++)
  1482.      for (k=0;k<((i<jsbound)?stereo:1);k++)
  1483.        putbits(bs,bit_alloc[k][i],(*alloc)[i][0].bits);
  1484. }
  1485.  
  1486. /************************************************************************/
  1487. /*                                    */
  1488. /* I_sample_encoding   (Layer I)                    */
  1489. /* II_sample_encoding  (Layer II)                    */
  1490. /*                                    */
  1491. /* PURPOSE:Put one frame of subband samples on to the bitstream     */
  1492. /*                                    */
  1493. /* SEMANTICS:  The number of bits allocated per sample is read from    */
  1494. /* the bit allocation information #bit_alloc#.    Layer 2         */
  1495. /* supports writing grouped samples for quantization steps        */
  1496. /* that are not a power of 2.                        */
  1497. /*                                    */
  1498. /************************************************************************/
  1499.  
  1500. void I_sample_encoding(sbband, bit_alloc, fr_ps, bs)
  1501. unsigned int FAR sbband[2][3][SCALE_BLOCK][SBLIMIT];
  1502. unsigned int bit_alloc[2][SBLIMIT];
  1503. frame_params *fr_ps;
  1504. Bit_stream_struc *bs;
  1505. {
  1506.    int i,j,k;
  1507.    int stereo  = fr_ps->stereo;
  1508.    int sblimit = fr_ps->sblimit;
  1509.    int jsbound = fr_ps->jsbound;
  1510.  
  1511.    for(j=0;j<SCALE_BLOCK;j++) {
  1512.      for(i=0;i<SBLIMIT;i++)
  1513.        for(k=0;k<((i<jsbound)?stereo:1);k++)
  1514.      if(bit_alloc[k][i]) putbits(bs,sbband[k][0][j][i],bit_alloc[k][i]+1);
  1515.    }
  1516. }
  1517.  
  1518. /***************************** Layer II  ********************************/
  1519.  
  1520. void II_sample_encoding(sbband, bit_alloc, fr_ps, bs)
  1521. unsigned int FAR sbband[2][3][SCALE_BLOCK][SBLIMIT];
  1522. unsigned int bit_alloc[2][SBLIMIT];
  1523. frame_params *fr_ps;
  1524. Bit_stream_struc *bs;
  1525. {
  1526.    unsigned int temp;
  1527.    unsigned int i,j,k,s,x,y;
  1528.    int stereo  = fr_ps->stereo;
  1529.    int sblimit = fr_ps->sblimit;
  1530.    int jsbound = fr_ps->jsbound;
  1531.    al_table *alloc = fr_ps->alloc;
  1532.  
  1533.    for (s=0;s<3;s++)
  1534.      for (j=0;j<SCALE_BLOCK;j+=3)
  1535.        for (i=0;i<sblimit;i++)
  1536.      for (k=0;k<((i<jsbound)?stereo:1);k++)
  1537.        if (bit_alloc[k][i]) {
  1538.          if ((*alloc)[i][bit_alloc[k][i]].group == 3) {
  1539.            for (x=0;x<3;x++) putbits(bs,sbband[k][s][j+x][i],
  1540.                      (*alloc)[i][bit_alloc[k][i]].bits);
  1541.          }
  1542.          else {
  1543.            y =(*alloc)[i][bit_alloc[k][i]].steps;
  1544.            temp = sbband[k][s][j][i] +
  1545.               sbband[k][s][j+1][i] * y +
  1546.               sbband[k][s][j+2][i] * y * y;
  1547.            putbits(bs,temp,(*alloc)[i][bit_alloc[k][i]].bits);
  1548.          }
  1549.        }
  1550. }
  1551.  
  1552. /************************************************************************/
  1553. /*                                    */
  1554. /* encode_CRC                                */
  1555. /*                                    */
  1556. /************************************************************************/
  1557.  
  1558. void encode_CRC(crc, bs)
  1559. unsigned int crc;
  1560. Bit_stream_struc *bs;
  1561. {
  1562.    putbits(bs, crc, 16);
  1563. }
  1564.